Block Diagram for Position/Velocity Loop